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ABSTRACT 


Extended Kalman filtering is applied to the PLRS (Position 
Locating Reporting System). Here the nonlinearity to the 
filter enters through the measurement (range only). The 
nonlinearity being the relationship between range and the 
cartesian coordinate states of the filter. 

Filter covariances of error are portrayed as error 
ellipsoids. These are used to determine which one should 
be used to update a unit when there are several other 
units available for ranging. One should attempt to make the 
range measurement in the same direction of the major axis of 
error associated with the unit to be updated. 

The filtering techniques are evaluated using static units 


and high speed maneuvering aircraft. 
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Error ellipsoids for two fixed units displaced 


along y-axis 15 KM --------------------------------- 


Projection of error ellipsoids to their x-y 
components and updated error ellipsoids after 


each unit ranges on the other ---------------------- 


Sequential updating of the units, one upon the 


other, over ten observations ----------------------- 


Aircraft in circular track at Mach 1 and radius 
£OOKM, Filter ranging only on unit #2: 
x= true track, O|= noise track, + = filter track 


AtGeeratte in. circular track at Mach 1 and radius 
HO-kKMs Filter ranging on: unit #2 and unit #1 
during second half. 

Mo= true track, =) noise. track, +.=xfilter track 


Arreratt in circular track at. Mach 1.and radius 

10 KM. Algorithm for choosing which ranging unit 
working POorly in Last third of flight. (unit #1 
ranges solely on last 20 observations. A too low 
Q is indicated by the track bias. 

yo true track, ©) = noise track, .+ = filter track 


Parcrate in circularitrack at Mach 1 and radius 

10 KM. Algorithm for choosing which ranging 

Unie working. © Sufilevent  to:.allow ‘filter to 
adequately track the turning maneuver. Measurement 
noise = 10 M. 

<—true track, G = noise track;,. +.= £iliter track 


Rirerart im circular track at Mach 1 and radius 

10 KM. Algorithm for choosing which ranging 
Untonworking. O Ssufticzent to allow filter. to 
adequately track the turning maneuver. Measurement 
noise = 100 M. 

x = true ‘track, O = noise track, + = £ilter track 


Aireratt in circular track at Mach 1 and radius 

10 KM. Algorithm for chooSing which ranging 

MWntt working. © Ssutficient to allow filter to 
adequately track the turning maneuver. Filter 
drops track due to extreme measurement noise (1 KM). 
“ = true track, © = noise track, + = filter track 
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Aircraft in circular track at Mach 1 and radius 

of 10 KM. Error ellipsoids presented on every 

fifth observation. Measurement noise = 10 M. 

Switching algorithm fails on x-axis. Ellipses 

25 times true scale. 

x = true track, ‘GO = norse*track, “+= filter track. -- 37 


Aireratt in Crrecular track at Mach land radius 

of) 10 KM. Switching algerithm corrected. Ellipses 

25 times true scale. 

x = true track, O = noise track, + = filter track -- 38 
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I. INTRODUCTION 


Position location of tactical elements in the Marine 
Corps in the past has relied upon the fact that these units 
had maps from which they could determine their position. 
Position determination is therefore highly dependent on the 
ability of an individual to correctly orient himself to the 
natural terrain surrounding him and locate this same terrain 
on the map. Once located, the requirement then exists to 
transmit position information via radio link to parent units. 
Meshed with the ground commander's problem of position 
location is the task of organizing and conducting support 
operations such as medical evacuation of wounded personnel, 
artillery, naval gunfire and air support. 

Using visual references it becomes difficult to accurately 
locate one's position when operating in mountainous terrain, 
in heavy vegetation, at night or in bad weather. And with 
the heavy volume of radio traffic experienced during battle, 
the probability of communicating to higher headquarters a 
unit's position or information about that position is reduced. 
As a result the support operations mentioned earlier are 
delayed because of detailed clearances required to ensure 
protection of friendly units whose position is not precisely 
known. 

The obstacles to position location suggested can and do 


arise in the conduct of actual operations, and for that 
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reason, the Marine Corps has written specifications detailing 
a Position Location and Reporting System (PLRS) designed for 
tactical employment on the battlefield, [1]. The system as 
construed is to consist of a containerized master unit 
composed of a general purpose computer and communications 
control electronics. This unit is referred to as the Master 
Unit. It is responsible for processing all range information 
inputs to the system, and displaying unit positions on a visual 
display with a variety of other information. 

The other units in the area are all portable, capable of 
being carried by a single man, vehicle, or aircraft. They 
are referred to as update or ranging units depending on their 
particular function at the time. When a unit's position is 
being improved, that unit is referred to as the "update" unit. 
All other units that are in contact with the update unit and 
are providing range measurements are "ranging" units. The 
frequency at which each unit is updated is specified according 
honrtes type. That ispaircraft.traveling at*much higher 
velocities than men will require updates more often if their 
tracking is to be accurate. 

Before a unit can be tracked and position estimates made, 
an initial estimate of position must be made. This process 
Of inttralization is controlled by the master unit. Once a 
unit is initialized the computer systematically selects 
ranging units processing their associated range information as 
applicable. In processing range information a new position 
estimate and a measure of the uncertainty in the estimate is 


provided. 
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While the processing of accumulated range information 
for an update unit appears to be straightforward, the 
difficulty lies in deciding which ranges to process so that 
the most accurate position estimates will be obtained. Range 
information is a measurement of the time required to send 
a Signal from the ranging unit to the update unit and back 
again plus some built in delays. 

While the measurement of times associated with the total 
time is quite accurate, it is still subject to the effects 
of noise therefore range is a noisy measurement. In addition 
the uncertainty of the ranging unit's position adds to the 
uncertainty of the measurement itself. Therefore the 
selection of a ranging unit to best update a particular unit 
becomes a very important factor in the position location 
problem. One would desire to use the ranging unit nearest 
the line of the major axis of error in the unit to be updated. 

The error ellipsoids of the "update" and "ranging" units 
and their relative geometry are analyzed and their influence 
on the tracking is portrayed in examples with maneuvering 


high speed aircraft and with stationary units. 
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II. POSITION LOCATING PROBLEM 

A. THE FILTER'S DYNAMIC MODEL 

OF AIRCRAFT UNITS 

First consider units in aircraft in a two dimensional 
space. The estimate that we seek in this problem is position 
tay) -and euch. (X,Y). X and Y are calculated with 
respect to a relative grid at a point on the earth's surface. 
The altitude is the vertical height above the earth at that 
DatLticular XY grid intersection, and is not utilized in this 
investigation. 


For tracking we may choose a fourth order state vector, 


(1) 


KeK Mex 


Writing the equations in linear state form results in 


x(k+1) ® x(k) + T w(k) (2) 


where 


6 = (3) 


* 
The altitude tracking will be handled independently. 
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f 0 
Bi 4 (4) 
0 = 
2 
0 T 


B, EXTENDED KALMAN FILTER 

The observable range is a nonlinear function of the 
states. So we must briefly look at how the nonlinearities 
can be handled in this type of problem. 

Consider a nonlinear discrete system of state and 


observation equations given by 

x(kt+l) = £(x(k),k) + g(x(k) ,k) -w(k) (5) 
and 

Ze) = B(x (ky Kk) + vk). (6) 
In these equations f, g and h are nonlinear functions of the 
state variables x, w(k) is plant excitation noise, and v(k) 


is measurement noise. The plant noise and measurement noise 


are assumed uncorrelated, zero-mean, and white. That is 
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El[w(k) - w' (5) ] 


Q*' (k) ae 


and 


E[v(k) + v'(3)] R(k) 6 


kj 

In order to apply the linear filter equations, (5) and 
(6) are expanded about the best estimate of the state at 
that time and only the first-order terms are kept. Equation 


(5) gives 


x(k+1) O(k) x(k) + T(k) + wk), (7) 


with 


malin 
[><] [eh 


% (k) 


Similarly Eq. (6) yields 


Zk) p= Re) ek) ov (CK) (8) 
where 
oh : 
H(k) = = : (9) 
OX | x=x" (k) 


x(k) is the estimated state value after the x th measurement 
pies (kis the predicted value of the state before the 


«th measurement. That is, 
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ea = Se (1) k= 1) (10) 
A state error vector is defined by 
ee = RR x(k), 
and a predicted state error vector is defined by 
BOAR RE xc) x(k) oo 
ene covariance of state error matrix is defined by 
Pa BRN as CN. j 


and the predicted covariance of state error matrix is given 


by 
' a oer marie § 
as Ene Gla)? oe OK) Js -< 
The state excitation matrix is given by 
a T 
OC) > = - BELEK) -wtk)-w Ck)-T (k)) 
and the measurement noise covariance matrix is 


Bie ety w(K) I 
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The Kalman Filter equations are given by [2] 


P'(k+1) = 6(k)P(k) 6 (k) + Q(k) (11) 
G(k) = P'(k)H (k) [H(k)P'(k)H'(k) + R(k)]7? (12) 
P(k) = [I - G(k)H(k)] P'(k) (13) 
tk) = £(R U1) |) (14) 
z'(k) = h(x'(k),k) 7 (15) 
Bg = x(k) + Clk) (z(k) — z"(k)) . (16) 


The Q matrix serves not only to allow for maneuvering 
but also to account for any model inaccuracies. That is, 
any discrepancies between the true action of the physical 
system and its characterization by Eq. (7). For a filter 
which reaches steady-state conditions the Q also serves to 
prevent the gain matrix G(k) from approaching zero by always 
insuring uncertainty in the predicted covariance of error 
macerx. P* (ky. 

The observation equation is nonlinear in the states and 
is given by 


2,1/2 


z(k) = [x(k)* + y(k) (17) 
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Equation (9) can. be used to give 


observation matrix. The result is 


H(k) = (vette 0 Des. Dae 0 | (18) 
x(k)? + y(k)? x(k)? + y(k)? 


In doing this, the recursive Kalman filter equations have 
been extended to cover the nonlinear case. The pseudo 
measurement matrix, H, must now be calculated from the position 
estimates at each time interval. 

The use of the Extended Kalman technique in tracking a 
unit as it moves through the area presents a unique problem. 
Because we are observing only the range, we can improve our 
estimate of location only along the direction of the range 
mectonr. . That 1s, the uncertainty or error variance in location 
remains unchanged in cross-range. We must then choose another 
ranging unit nearby that will improve upon this cross range 
error. This however is done later at the next prescribed 
interval for update of the unit in question. 

The conclusion drawn from this observation is that it is 
critical that an algorithm be developed for selecting the 
best observations (ranging units) to process in the updating 
of a unit. It will be shown that this algorithm must be 
dependent on the physical geometry associated with the 
covariance error ellipses. It takes into consideration the 
error covariances associated with both the update and ranging 


wnics. 
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III. RANGE MEASUREMENT PROCESSING AND ERROR ELLIPSOIDS 


The position of each unit within the system is established 
with a degree of uncertainty about the estimate. This 
uncertainty is expressed in the covariance of error matrix, 

P, and represents the sigma squared error deviation about the 


estimate. The position diagonal terms (P and P43) of the 


gal 
covariance matrix represent the variances of the estimate in 
the XY coordinate directions. Their Peeneeeiie off diagonal 
terms (covariances) represent the degree of coupling and the 
orientation of the uncertainty in the XY plane. 

If the errors were normally distributed, there exists a 
rotated coordinate system such that in the new system the 
orthogonal position components are uncorrelated. This is 
equivalent to taking the exponent of the joint normal 
probability density function, and applying a coordinate 


transformation which eliminates the cross terms. 


The exponent (for zero-mean random variables) is 


x? 2r XY a2 

~~ Ls . (19) 
Oo o_o fe) 
x x y 


When set equal to a constant, this curve, which is an ellipse, 
is a curve of constant probability. This ellipse does not 
have its major and minor axes aligned with the coordinate 


system however. By applying the transformation 


ny 


<1 x COS 6 -+"y sin 6 (20) 


and 
vos vy Gos 0 = x sin *6 (21) 
with 
Ae = tan” 2 cov (ey) ; (22) 
oO Oo 
x ¥. 


the ellipse will be aligned with the x', y' axis and the 
resultant random variables will be uncorrelated. The new 


variances in this system are calculated by 


Z 2 
2 Ox Ee cov (xy) 
, — 
ox x 2 Teena (23) 
and 
Oo 246 = 
- Cae x Vou. COmi(xs) (24) 
y 2 Sin 20 a 


This method of viewing the sample statistics provides insight 
into the filter performance because it shows the regions of 
high probability and their geometric relationships. The 
values of ay and ee are referred to as the rotated 


error variances in the following section. 
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When a range measurement is made between two units, each 
with a different and independent error ellipse, the uncertainty 
of position along the range line connecting the two is improved 
for both units. In addition, it is sometimes possible to 
reduce the error of the axis orthogonal to the range line 
depending on the orientation of the error ellipse. 

To study the influence of the error ellipsoids of the 
ranging and update unit let us consider a static example. 

This model is synomymous with those used for foot soldiers. 

Measurement noise will be considered to come solely from 
the error variance of the ranging unit and vice versa when 
their roles interchanged. That is, at the same time the 
"update" unit is being updated, let us also update the 
"ranging" unit. The estimates of position and their error 
ellipsoids are shown in Fig. l. 

A projection of the error ellipsoid along the y-axis 
eo Given in Fig. 2. <1If ome utilizes each as an observation 
to update the other, the resulting variance of both along 


the range line is given by 


_ 


where OF and J, are the standard deviations of units 1 and 2 
in the range projection and Ooh is the new updated standard 
deviation for both units in the range projection (0,), as 


vé 
es Seen aiso in Fig. 2. 
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BTGURE 1. Error ellipsoids for two fixed units displaced 
along y-axis 15 KM 
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Thus the processing of an error free measurement between 
two units provides a better statistical description of both 
units along the range line. 

This discussion considered fixed units with no velocity 
and only in the XY plane. Central to the equations employed 
in the Kalman filter are equations calculating the gains and 
the error covariance matrix. By merely adding the component 
of the variance of the ranging unit along the range line to 
the measurement noise in the calculation of the Kalman gains, 
the Kalman filter reduces the covariance matrix of the update 
unit properly. 

The uncoupled error matrices and their directions are 


(from eqs. (22)-(24)) 


4 0 
Pp t = , 6 = -30° 
1 0 100 i 
and 
100 0 
a - 62 5= 130° 
2 > A 2 


After update the resulting covariances are (see Fig. 2) 


di eae. 1. Le 
P, (new) = 
2 igs a) 20.46 
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and 


59.42 30.34 
P. (new) 
30.34 20.46 


Their uncoupled equivalents 


3.89 0 
P, ' (new) = ; 6, (new) = = 34° 
0 28 
and 
7.6 0 
P.' (new) = - 6. (new) = 28262 
0 Beco 
After ten updating operations 
5.33 902 
Py (new) = ’ 
0.02 0.04 
14.52 0.06 
P.' (new) = 
06 0.04 
and their uncoupled equivalents 
5234 0 
P, ‘ (new) = ’ 8, ' (new) nies 
0 08 
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P.' = ; 0. ' (new) = 10 .46° 


In Fig. 3 we see the influence of the sequential 
updating of the units, one upon the other over ten 
observations. 

Note that the successive ranging in the y-direction 
Perectivery reduced*the«error variance in -y, and its 
projection in x due to the xy covariance. This was 
accomplished by assuming the measurement noise consists 
solely of the y component of the error variance of the 


ether unit ranging upon it. 
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FIGURE 3. Sequential updating of the units, one upon the 
other, over ten observations 
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IV. TRACKING AND MANEUVERING TARGETS 


ae LHe CHOLCE OF © 

One ROas tee approach in designing a filter to accomodate 
maneuvers is to increase the random forcing excitation 
covariance, Q, until the filter adequately tracks the 
Peeeplated mancuvers. Normally this is done in a tracking 
Simulation program. The running filter error residual, 
p(k) - x(k/k) ) appears to be a better indicator Of effec 


tiveness than either mean error 


Mean Error = 


ale 


k 
er) = 75) 
j=1 


ee for that matter, error variance... Filter lag or bias as 
is best seen in the sign of the error, is lost in the 
squaring process for the variance. Also, the mean and 
variance error entail an accumulation of all error from 
start up to the present time. In a simulation, a maneuver 
may Often not occur until well. into a tracking run, and its 
effect may not appear as markedly in the mean error and error 
variance. A Monte Carlo simulation is often an effective 
design tool here. However, unless considerable engineering 
insight is used the resulting filter has been designed to 
handle the zero mean maneuver. That is, the filter will be 
designed against an ensemble of maneuvering tracks the mean 


of which is no maneuver at all. It appears that a more 
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successful procedure is to design against a highly probable 
worst case maneuver. The resulting filter should then be 
able to handle all possible contingencies, which is a 
necessary ingredient in most military systems. 

The price paid in having a rather high O in a filter 
design is an increased degradation in filter performance due 
to the measurement noise variance, R. In this application 
the measurement noise is minimal. The important thing is 
to attempt range measurements along the axis of maximum 


filter error variance as discussed in Section III. 


B. SIMULATION RESULTS 

Pneaireratt Elying at Mach 1. follows-a turn of radius 
10 KM. Ranging unit 1 is located at the oti. Unit 2 
is placed at (10 KM, 190 KM). We have the below filter 


parameters for Figs. 4 through 11 are 


fade © 40k 0 
Ona tg 6 
Pee neldl' Gt toe Ri che ' 
OF Gra 0 a 
0.5 
coe 0 
6.5 
0 i: 
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and the initial conditions of 


10 0 0 0 
Otomo" 6 
P(1/0) = a 
0 0 10 0 
0 0 0 107 
and 
0 
0.333 KM/S 
X(1) = x17 0) = 10 KM 
0 


In Fig. 4 we have the first attempt at the algorithm 
for choosing the ranging unit nearest the line generated 
from the major axis of error in the error ellipsoid of the 
tracker. It ranged solely on unit 2 and failed to follow 
Paetsch. . Similarlyein Figg S,;ithe filter ranged on unit 2 
pee the first half, ofthe flight and on unit 1 for the 
second half. 

The evolution of the design of the filter is presented 
here so that the errors in the design process may help to 
give insight into the filter's performance. 

In Fig. 6 we see the beginning of proper functioning of 
the ranging algorithm (except on the last 20 observations). 
Note also that the covariance of excitation, Q, is insuf- 


ficient to follow the maneuver as is indicated by the bias 


28 


| 


iy 9 


ti 4 


ii@ 


-— 


| 


tere £2 be shee auid-Seol iek ogi 


* oO 

9 e 
ee 
or” 5 
Q 


2a\4% t@t.8 ay 
] 
2 ; a s : 
> tamer sé SAVES GR? saved ow\d\, sit 


wis tasisea ahite QelennT ods 90120 


> ~49 nl texts Ge alee soten 


a 


cis 2 ther te Viblol Rapes St hee 
ote? of .@? ee Me ytaatints om 
“a spill oe9 de thie rave 
“yilad 


7 


ngioeh ats I¢ eolsuiove 


eet elt al aesecte eid sade 


nerjohcee a peetrd ety cond Sdeleeee 
te wilowtted GAs one al ® «gee 
janl od? a6 Jqeoes) nisi sopia gasg ry 


‘jure fo sui ineeoe at? Jac? ofG8 


a 
a 
: 


mm the filter track from the true track. Here we have 
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In Fig. 7 the algorithm appears to be functioning 
Properly. and there is sufficient Q for the filter to follow 


the turn. Here we have 


Gqare = 0K 25 


In Fig. 8 the filter was tested for its response to 
increasing the measurement noise (from OL = 0.01 KM to 
= 0.1 KM). It tracked well. However in Fig. 9, when 
the noise was again increased (o,, = ]1 KM) the track was lost 


immediately. This gives one a ball-park indication of filter 


performance as the ranging observations are degraded. 
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Figure 10 shows the filter performance with the error 
ellipsoids superimposed at every fifth observation. It 
indicates a short malfunction of the switching algorithm 
when the track crosses the x-axis. This was corrected in 
Fig. 11. The error ellipsoids are expanded to twenty-five 
times their true value in order that they may be seen. 

In the appendix we have listed the computer simulation 


program with comments regarding its operation. 
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FIGURE 4. Aircraft in circular track at Mach 1 and radius 
LO RM.  Pidter ranging only on unit G2. 
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BPEGURE 5. Aircraft in circular track at Mach 1 and radius 


LOenhM.  Ptiter ranging On unit #2 and unit #1 
during second half. 
x = true track, “OG = 


noise track, + = filter track 
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PEGURE 6. Aireraft in circular track at Mach.1 and radius 
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Airerert in cinrcularvirack at.Mach 1 and radius 
of 10 KM. Error ellipsoids presented on every 
fifth observation. Measurement noise = 10 M. 
Switching algorithm fails on x-axis. Ellipses 
25 times true scale. 
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V. CONCLUSIONS 


The evolution of this filter design appears to have 
some merit. The maneuvering target can be tracked handily 
with adequate choice of Q. The filter operated well in all 
but impossible ranging noise situations. The real system 
has ne noise on the order of ten meters. The filter tracked 
well with a range noise sigma of one hundred meters. 

tHe algorithm for choosing which: unit to Vink to: for 
manging: is? finally operating satisfactorily. “In fact, this 
may be the real contribution of this work. Another possible 
benefit is the use of graphical presentation of the error 
ellipsoids in filter evaluation. They were most essential 
in the algorithm for choosing ranging links and in the Q 
evaluation. 

Still to be accomplished are: an initialization algorithm, 
a spurious data gating scheme and a track deletion logic. 
The latter two items may be dispatched readily by letting 


Gate(k) = 3 P47 (k/k-1) tigre (as) 


a 
and if a unit receives no range update. Within the gate 
for, say, six update sequence times, then reinitialize and 
Scart OVEr « 

The rotation and reduction of the error ellipsoids (i.e. 
the filter error Aeyaban es was most instructive and gave 


much insight into the performance of the filter. 
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FILTER FOR STATIC UNITS TRACKING 
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